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Motor rotational 

number Nm(n) 
detecting 



S 4 O 



S 5 0 



Band pass filter calculation 
BNin(n) = al*BN»{n-1}+a2*BHn(n-2)H^^ 
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PD control calculation 
PD_out = Kp*BNin(n)+Kd*(BMin(n)-BNiB(n-1)) S 6 0 



Instruction torque calculation 
Ti - Req_trq - PD_out 
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Instruction torque Tn 
Current instruction value I, Angle instrucation value 6 



Current instruction value, 
angle instruction value output 
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Design method 



Identification experiment 
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Model parameter identification 
by frequency fitting 



Reference model derivation 



PD control calculation by 
model matching method 



Scattered of control ler 
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Design nethod 



Identification experiment S 3 0 1 



Model parameter identification 
by frequency fitting 



Reference model derivation 



Characteristic fluctuation 
derivation 



Noise characteristic 
derivation 



Weighting function set 



| Generalized plant creation "[ 



Controller JC(s), 
Scaling matrix D calcination 
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Performance estimation 
condi t ion: 
satisfied. 
Yes 



Reduced model for controller 



Scattered of control ler 
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Find Target torque 
(Req_t rq) 
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number Nn(n) 
detection 
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„ Corrected amount calculation 
U(k) = la I u(k-l) + lb I Nm (k-i) 

i=1 1=0 



Instruction torque T for motor calculation 
T - Req_trq + u(k) 
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Instruction torque Tn (by nap serch) 
►Current instruction value I, Angle instruction value 6 
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Current instruction value, 
Angle instruction value output 
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